#ifndef  _CONTROL_H
#define  _CONTROL_H

#include "sys.h" 



void PID(float Angel_X,float Angel_Y,float target_x,float target_y);
void Load(u16 motor1,u16 motor2);
int GFP_abs(int p);


#endif

